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Abstract —We present a novel parametric message representa¬ 
tion for belief propagation (BP) that provides a novel grid-based 
way to address the cooperative localization problem in wireless 
networks. The proposed Grid-BP approach allows faster calcu¬ 
lations than non-parametric representations and works well with 
existing grid-based coordinate systems, e.g., NATO’s military grid 
reference system (MGRS). This overcomes the hidden challenge 
inherent in all distribnted localization algorithms that require a 
universally known global reference system (GCS), even though 
every node localizes using arbitrary local coordinate systems 
(LCSs) for a reference. Simulation results demonstrate that Grid- 
BP achieves similar accuracy at much reduced complexity when 
compared to common techniques that assume ideal reference. 

Index Terms —Belief propagation, cooperative localization. 

1. Introduction 

The unprecedented adoption of mobile handhelds has cre¬ 
ated a host of new services that require accurate localization, 
even in GPS-denied environments. How to accurately localize 
without satellite positioning has been an active research topic. 
Various cooperative localization methods have been developed 
suitable to high noise scenarios, e.g., indoors [1,2]. 

A. The Forgotten Challenge 

The motivation behind this work is the assumption in the 
literature of distributed cooperative localization that requires 
a universally known global coordinate system (GCS). Even in 
anchor-free algorithms, such as those in [3-5], where nodes 
localize to a relative local coordinate system (LCS) only, the 
anchors with shared GCS knowledge are required to transform 
the local coordinates to global ones. Otherwise, nodes would 
have no idea the whereabout of the global origin. In the case 
of distributed ad-hoc networks, where the anchors are simply 
nodes with a good estimate of their GPS coordinates, achieving 
a shared GCS between them is non-trivial. Presumably, in 
this case, the anchors would have to communicate with each 
other to agree on a GCS with a common origin and pass 
that information to the rest of the network nodes. In addition, 
up-to-date information between nodes should be maintained, 
inducing an increased communication overhead. 

The solution we suggest is to use directly a GCS for all 
calculations, therefore eliminating any need for LCS and all of 
the described issues. The first obvious choice of a GCS would 
be to use GPS as a common GCS to all nodes. Unfortunately 
using GPS coordinates in message passing operations would 
easily make calculations underflow due to the small distances 
inherent in indoors localization, and would require scaling and 
normalization at each node. This means that every node would 

This work is supported under EPSRC grant EP/HOl 1536/1. 

P. Oikonomou-Eilandras and K. Wong are with the Department of Electronic 
and Electrical Engineering, University College London, WCIE 7JE, UK. Y. 
Zhang is with Kuang-Chi Institute of Advanced Technology, China. 


have to convert incoming messages to a LCS, suitable for 
message passing operations, and then convert them back to 
the GCS for transmission, increasing the computational cost of 
the algorithm. Instead, we propose a grid-based GCS that can 
be used directly to conduct message passing operations and at 
the same time hugely decrease the computational cost. In this 
manner we both remove any requirement for the networks to 
consent on a GCS and also achieve very low complexity. 

B. Our Contributions 

This correspondence proposes a novel scheme that uses a 
GCS system suitable for message passing algorithms in coop¬ 
erative localization. As a real-life example, we use the NATO’s 
military grid reference system (MGRS), cf. [6].' The approach 
no longer requires GCS coordination between anchors. Also, 
it has inspired the use of parametric representations using 
multinomial probability mass functions (pmfs), allowing for 
a fast robust and accurate cooperative localization algorithm 
that elegantly resolves the GCS knowledge requirement. In 
summary, we have made the following contributions: 

• We propose a grid-based GCS solution, i.e., map GPS co¬ 
ordinates to unique grid identifiers, solving the common 
reference issue in all distributed localization techniques. 

• Parametric approximations to the pmfs are proposed to 
overcome the computational bottleneck of non-parametric 
belief propagation (BP) used in cooperative localization. 

• Simulation results illustrate that the proposed grid-based 
BP method, which is referred to as Grid-BP, provides 
similar accuracy with low computational cost when com¬ 
pared to common techniques with ideal reference. 

II. Problem Lormulation 

We consider a network of nodes in a 2D environment which 
consists of N agents and M anchors, where M > A and 
N M. Let the space be subdivided into a square grid where 
each square “bucket” has a unique identifier, namely an ID. 
Then let X = [Xi,..., Xi,..., Xn+m] be the locations of 
all nodes, with Xi representing the unique identifier of node 
i and Xi G {xi,X 2 ,.. .Xk}, where k iterates over all possible 
IDs. Also, let Z denote the coordinates of all nodes, with Zi 
representing the coordinates of node i, and the domain of Zi is 
3?^. The nodes communicate wirelessly and it is assumed that 
the maximum communication range for each node is i?max- 
Time is slotted and time slots are denoted by the time index 
superscript (t) for < = 1, 2,. .., oo. We represent the problem 
as a joint pmf. Let p^*''>{Xi) be the pmf, i.e., the belief that 
node i has about its location at time t. We model p^^^Xi) 

’Even though this letter uses the NATO’s MGRS coordinate system, any 
grid-based coordinate system can be used with trivial changes. 



as a multinomial distribution with parameters 0k, where 9k 
is the probability of node i being in ID Xk and J2k^k = 1- 
In addition, let the set of all nodes j within range of node i 
be denoted as the neighbourhood A/i. Initially, the belief for 
the agents can be a non-informative uniform pmf over the 
grid, while the anchors’ pmfs are focused in the IDs close to 
the real position, e.g., within 10m. Anchors can obtain their 
IDs either by directly mapping them from satellite data, cf. 
[ 6 ]. Node i receiving a message from node j at time slot t 
can derive, using time-of-arrival (ToA) measurements,^ a noisy 
estimate of the distance between them. For convenience, 

(i) (t) (t) 

we assume r] 4 . = 44 ^. = 44 

Thus, as in [7] for ToA distance measurements, we define 
the random variable Rji with its value rji modelled as 


A. Belief Message Passing 

The network can be modelled as a cluster graph and loopy 
belief message passing algorithm can be used. We adopt a 
Bethe cluster graph [10]. The lower factors are composed of 
univariate potentials f>{Xi). The upper region is composed of 
factors equal to Xj, Rji), e.g., see Fig. 1. 



Fig. 1. The cluster graph. Lower row factors denote the node position beliefs. 
Upper row factors denote the ranging interactions between the nodes. 


rji = \\zi-Zj\\+r]j„ ( 1 ) 

where r/ji is a Gaussian noise with variance = Ke\\zi — 
ZjW^^^ in which Kg is a proportionality constant capturing the 
combined physical layer and receiver effect, and Pji denotes 
the path loss exponent. In the case of line-of-sight (LoS), riji 
is assumed zero mean, and f3ji = 2, i.e., r]ji ~ M{Q, o'ji). In 
this work we assume only LoS, but it would be easy to extend 
the algorithm with NLoS mitigation, by using e.g. [8,9]. 

We define the likelihood of node i and node j measuring 
distance Rji = Vji between them at time t, given Xi,Xj as 

p^^\Rji = Tji \Xi,Xj)(x exp ^ 

( 2 ) 

where h controls steepness, Ci and Cj are the coordinates 
of the centers of the grids’ squares Xi and Xj, respectively. 
Therefore, our objective is to find the maximum a posteriori 
(MAP), i.e., the values that maximize p{X\R) given distance 
measurements R = \Rji]. For a specific node i, we have 

Xi = argnmxp^*)(Xi|i?i). (3) 

Thus, p^*’''{Xi\Ri) can be evaluated using the Bayes’ rule as 

cxp(‘)(X4 J] f p^^HR,,\X,,X,)p<-^\X,)dXj, 


in which the sign “ex” means “is proportional to”, and nor¬ 
malization should be done to obtain the pmf. 

III. The Proposed Grid-BP Algorithm 

Cooperative localization can be viewed as running inference 
on a probabilistic graphical model (PGM) [2], where messages 
are representations or probability functions. Here, the proposed 
grid-based localization algorithm will be presented. First, the 
use of a cluster graph and BP will be motivated, and the used 
PGM will be analysed. Then efficient approximation for the 
marginalization and the product operation will be given. 

^The assumption of using ToA is not restrictive on the proposed algorithm 
because it can easily be used with other measurement models. 


The lower factors are set to the initial beliefs for the given 
time slot (t), and the upper factors to the corresponding cpmfs: 


Xj , Rji 


f{Xi)=p<^^\Xf, 

= r^)=I^^iRp=r^\X,,Xj). 


(5) 

(6) 


Messages are then passed between nodes for multiple itera¬ 
tions until the node beliefs have converged. The message from 
node j to node i, at BP iteration (s -f 1) is calculated by 




(s+1) 


(X0= / f{X,,X„R,, = rf) 








dX„ (7) 


where intuitively, a message (7) is the belief that node j has 
about the location of node i and r'f} is the observed value of 
the distance between the nodes, at time slot t. 

Then the belief of node i is updated as 


= J] p^^X?iXi) + {l-\)b^:\Xi), (8) 

keXi 


where A is a dampening factor used to facilitate conver¬ 
gence. BP continues until convergence, or if convergence is 
not guaranteed, s reaches a maximum number of iterations 
^max- Then the beliefs, representing approximations to the true 
marginals, for each node are found by ( 8 ), i.e., (Xf = 

b[^~^^\Xi). The proposed Grid-BP is given as Algorithm 1. 
Each node needs to perform a marginalization operation (7), 
and a product operation ( 8 ). Approximations are required for 
both complex operations. In Grid-BP, we take advantage of 
the multinomial parametric form which we discuss next. 


B. Marginalization Operation (7) 

The calculation of (7) gives the belief node j has about node 
i. To understand this, let us assume the case where all energy in 
bj^\Xj) is concentrated at a single ID Xj, then node j would 
believe that node i is located in one of the IDs that approximate 
a “circle ” with centre Xj and radius Hence, to get 
p^j'fl^PiXi), first we draw L particles from Xj'^ ~ bj'^\Xj). 
Then we draw L samples from ~ W(0, 27r) and L samples 
from ~ Af{r^*^\h). The Gibbs sampling algorithm is 
provided as Algorithm 2. We repeat Algorithm 2 for all 
incoming messages and we will get {a:^^ 



Algorithm 1 Grid-BP 

1: Initialize beliefs p^^\Xi) Vi € Nodes 
2: for f = 0 to r do 
3: for all i G Nodes do 

4: Broadcast current belief 

5: for all j G Afi do 

6: Collect distance estimates 

1 : end for 

8 : end for 

9: Initialize'!/)(Ai) = (Ai) 

10: Initialize Xj,Rij) = {R^j = \ Xi,Xj) 

11: repeat 

12 : for all i G Nodes do 

13: for all j G Ni do 

14: Receive b^p{Xj) 

15: Calculate lJi^jA^l\Xi), using (7) using Gibbs 

sampling (i.e., Algorithm 2) 

16 : end for 

17: Calculate b^^^^\Xi), using (8). 

18: Check for convergence 

19: Send 

20 : end for 

21: until convergence or s reaches /max 

22: Update belief using (8). 

23: end for 


Algorithm 2 Grid Gibbs Sampling 
1: Set Vxi to empty 

2: for all j G Ni do 

3: Sample ~ fij^i{Xj) which is a multinomial pdf 

4: Sample ~//[0,27r] 

5: Sample ~ N{rf^ ,h) 

6: = MAP-DMtolD(a:j*\ which maps the 

distance metric to IDs 
7: Add {xf’jti to Vx, 

8 : end for 
9: return Vxi 


adding dn, dy to the easting and northing components of the 
ID of x'^p, to be discussed in Section IV. There is no need to 
do any reverse mapping as we directly get the new IDs. 


Algorithm 3 MAP-DMtolD 
1: Calculate horizontal and vertical steps using (10) 
2: Map horizontal ID x^p —)■ b^ 

3: bP = bf +dH 

4: Inverse horizontal mapping bP ^ xP 
5: Map vertical ID xp — >■ bp 

6: bP = bP + dv 

7: Inverse vertical mapping bP xP 

8 : return xP 


C. Product Operation ( 8 ) 

To obtain (8), we will first convert the samples calculated 
for each message pppp (Xi), (7), to parametric multinomial 
pmfs and then calculate their product. We assume that the 
parameters of each multinomial are random variables &i with 
a uniform Dirichlet prior with parameters a = [ai • • • ax], 
where K denotes the number of unique IDs in the pmf, i.e. 
PpPPiXi) « pppp{Xi\&i;a.). Firstly we use the samples 
from each incoming message as observations and get the 
MAP estimate 6i = [Oip ■ ■ ■ Oi^x] of the parameters 0^ of 
each pppp {Xi\&i; a). We also assume that all incoming 
messages have the same prior distribution. This allows us to 
efficiently create parametric forms of the incoming messages 
as multinomial pmfs. These parameters are calculated as 

e,=E[P{&,\Vx,)]=E[p{Vx.\&^)p{®^)], (11) 


which gives 


Mk + lA/ilctfc 

l-^il 12 i^k + CMk) ’ 


( 12 ) 


It is important to note that in order to combine the distance 
metric with the sampled IDs {^P} and get the set Vi = 
{xP}, we use a mapping function which we define as 

xP = MAP-DMtolD(xf (9) 

Intuitively we do this by counting for each sampled ID xP^ 
the number of IDs to the east and to the north, node i will be, 
given the measured distance samples fP normalized by D as 


dn 

dv 


= int 



cos{p^2 \ 

sin(0(*^) j 


( 10 ) 


Then we map the displacement dx^dv to a new ID and 
return it as xP. The set Vxi of all samples obtained from 
all incoming messages is used to find (8). The distance to 
ID mapping function is given as Algorithm 3. In the case of 
MGRS IDs the horizontal and vertical mappings are done by 


where is number of particles a;^ in Vxi- The algorithm is 
presented in Algorithm 4. For clarity, the quantities of each ID 
in the samples are shown as being found by a count function 
but in practice it can be done during the Gibbs sampling 
step allowing for a more efficient algorithm. Finally, with the 
parametric forms of each (7) in hand, we can easily calculate 
(8) as the dot product of the 6i parameters of all incoming 
messages and the node’s own belief. 


Algorithm 4 MAP Parameter Estimation 
1: Let \Xi\ be the number of unique IDs in p{Xi\&i) 
2: Calculate Mk = count(xfe,I?Xi) V/ G \Xi\ 

3: for all k € I Ail do 
4: Calculate Oi^k, with (12) 

5: end for 
6 : return 6i 









D. Message Filtering 

As it makes no sense to keep all the possible IDs on the 
planet wide GCS, we consider that each node constructs pmfs 
with the IDs only within a specific range i?grid, e.g., within 
100m, of the IDs it receives in the first iteration. To reduce the 
IDs further, we propose a simple filter to only keep the most 
probable IDs summing up to an energy threshold. Simulation 
results (not included in this paper) suggest that by keeping 
~ 80% of the total energy of the pmf, the size of the messages 
is decreased by ~ 90% with no increase in localization error. 
Thus, assuming that each message covers a 100 x lOOm^ grid, 
the total number of IDs used without the filter would be 10^. 
After the filter, only ~ 100 IDs will be transmitted. 

E. Complexity 

Most message passing cooperative localization algorithms 
tend to use a variant of Gibbs sampling to calculate (7) with 
similar computational costs [11]. Hence, the complexity cost 
tends to be bounded by the product operation (8) cost. As Grid- 
BP multiplies parametric form multinomials, the operation is 
bounded by K{\Afi \ + 1), where K is the average number of 
IDs used in the calculations. The computational cost for the 
product operation of the compared algorithms is summarized 
in Table I, where L is the number of particles and jA/) | is the 
number of messages involved and /nybrid-BP is the number of 
iterations the product algorithm in [12] is run. 


TABLE I 

Comparison of complexity costs of (8).§ 


Approach 

Algorithm 

Complexity 

Non-parametric 

Non-parametric 

Parametric 

Parametric 

NBP 

HEVA-BP 

Grid-BP 

Hybrid-BP 

-^Hybrid-BP-^NBp|A^i|(|M| + 1) 


§Note that K ~ Lheva I^nbp, and typically /nybrid-BP ~ 100. 


IV. Review of MGRS 

In this correspondence, as a grid based system, we employ 
MGRS, which is the geo-coordinate standard used by NATO 
military for locating points on the planet [6] and a combination 
of the universal transverse mercator (UTM) grid system and 
the universal polar stereographic (UPS) grid system, with a 
different labelling convention. It is essentially a global mesh 
grid that assigns a unique ID to each grid square. An example 
ID is 10QCG12345678, where the first part “lOQ” is called 
the grid zone designator (GZD), the second part “CG” is the 
100,000-meter-square identifier, and finally the last numerical 
part gives the easting (first half digits) and northing (second 
half digits) inside the square identifier. Every two digits used 
(for a minimum of 2 and a maximum of 10) increase the 
resolution by a factor of 10m, down to a resolution of Im^ 
grid squares. Map coordinates are read from west to east first 
(easting), then from south to north (northing), i.e., left-right, 
down-up. In cases where the part of the ID is common to 
all neighbouring nodes, the common part can be dropped and 
only the rest need to be transmitted or used. For details on the 
specifics of MGRS, readers are referred to [6]. 


V. Simulation Results 

To assess the performance of Grid-BP, we conducted 300 
Monte-Carlo simulations and the root-mean-square (RMS) 
localization error was calculated for various noise levels. 

In each simulation 100 nodes with 20 anchors are placed 
randomly in a 100m x 100m area and the communication 
range is limited to 12m and |A/i|avrg = 4.03. Anchor locations 
are modelled as multivariate Gaussian pdfs with an identity 
variance matrix. The grid resolution for Grid-BP is D = Im. 
We compare Grid-BP with HEVA-BP [8], a computationally 
cheaper variation of non-parametric BP (NBP) [13]. We also 
compare it with a parametric belief propagation algorithm, 
namely Hybrid-BP [12].^ In addition, the maximum number 
of message passing iterations is set to be /^ax = 15. The 
experiments were run for different noise levels with the noise 
factor used ranging between Kg = [0.0 — 0.3] and the number 
of particles being 200. Furthermore, to showcase the increased 
complexity of using GPS coordinates as a common GCS, a 
variant of HEVA that uses GPS was also provided. In HEVA- 
GPS, messages contain GPS coordinates that every node 
converts to an ECS before calculating (7) and (8). Afterwards 
the updated beliefs are converted back to GPS coordinates and 
transmitted. 

In Fig. 2, the RMS localization error of all the algorithms as 
the noise coefficient increases is shown. We see that HEVA-BP 
and HEVA-BP-GPS have a better accuracy than both Grib-BP 
and Hybrid-BP. Grid-BP has a slightly higher RMS error. 

In Fig. 3, the average simulation time against the number 
of particles is shown. The improvement in computational cost 
by Grid-BP is observed, especially as the number of particles 
increases. It should also be noted that for higher particle 
numbers the cost of GPS scaling becomes almost insignificant 
compared to the cost of message passing equations. 

Note that both algorithms, HEVA and Hybrid-BP have the 
strong assumption of sharing knowledge of the GCS origin, 
while Grid-BP and HEVA-GPS do not (the realistic scenario). 
Even though HEVA-BP-GPS performs as good as HEVA-BP, 
there is an increase in computational cost with HEVA-BP due 
to the mapping of the GPS coordinates to a local Cartesian 
reference frame (as can be observed in the mean simulation 
time in Fig. 3). As the number of particles gets higher, the 
relative computational efficiency of Grid-BP can also be seen. 
Note that all the simulations shown were run on an Intel i7 
2.6GHz, using Python for scientific computing [14]. 

VI. Conclusion 

This correspondence has proposed a novel parametric BP 
algorithm for cooperative localization that uses a grid-based 
system. The resulting Grid-BP algorithm combines a grid- 
based GCS that alleviates the hidden issue of requiring shared 
reference knowledge, and a parametric representation which 
allows quick and efficient inference. Simulation results showed 
that Grid-BP’s performance is significantly better than other 
BP algorithms that rely on a known GCS. Grid-BP is also 

^For Hybrid-BP [12], we did not use information given from satellites. 
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Fig. 2. The rms eiTor versus the amount of range estimation noise Ke when 
the average node connectivity is 4.03 

easy to be extended for mobile applications and add the non- 
LoS mitigation filter proposed in [8], making it a versatile and 
reliable choice in both military and civilian applications. 
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